

void setup() {
Serial.begin(9600);
}

void loop() {
move(1, 1600, 1000);
move(0, 1600, 1000);
move(1, 1600, 1000);
move(2, 1500, 750);
move(3, 950, 750);
move(1, 800, 750);

delay(10000);
move(1, 1600, 1000);
move(0, 300, 1000);
move(1, 2000, 1000);
delay(10000);
}

void move(int servo, int position, int time) {
Serial.print("#");
Serial.print(servo);
Serial.print(" P");
Serial.print(position);
Serial.print(" T");
Serial.println(time);
delay(time);
}
